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Input: f (start point), e (ending point), Dist(p,q) (local distance 

definition) 
Assistant Data Structure: 

LI (active list 1) 

L2 (active list 2) 

C(p) (cumulative distance from f to p) 
Output: ptr (minimal cost path pointers) 
Algorithm: 

(1001) Initialize assistant data structure (LI, L2 are set empty, and 
C to +oo). 

(1002) Set initial threshold To and increasing step St- 

(1003) T = T 0 ; 

(1004) push(Ll, f, 0 ); . 

(1005) while( T <= Tmax and C(e)==4-oo ) { 



(1006) while( num(Ll)>0 ) { 

(1007) pop(Ll, p); 

( 1008) nag_thresholded==0; 

(1009) for (each q e N(p)) { 

(1010) if( Dist(p, q)>T ) { 

(1011) flag_threshold=l; continue; 

(1012) } 

(1013) d! = C(p) +Dist(p,9); 

(1014) if( d! <C(q) ) { 

(1015) if( q is in LI ) remove( LI, q ); 
'(1016) C(q)=d , ; 

(1017) Ptr(q)=p; 

(1018) push( LI, q, d! ); 

(1019) } 

(1020) } //end of for 

(1021) if( Hag-threshold ) { 

(1022) push( L2, p, C(p) ); 

(1023) } 

(1024) } //end of inner while 

(1025) T=T-H5 T ; 

(1026) Copy LI from L2 and clean L2. 



(1027) } //end of outer while 
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